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Abstract — This paper provides nonlinear tracking control 
systems for a quadrotor unmanned aerial vehicle (UAV) that 
are robust to bounded uncertainties. A mathematical model of a 
quadrotor UAV is defined on the special Euclidean group, and 
nonlinear output-tracking controllers are developed to follow 
(1) an attitude command, and (2) a position command for the 
vehicle center of mass. The controlled system has the desirable 
properties that the tracking errors are uniformly ultimately 
bounded, and the size of the ultimate bound can be arbitrarily 
reduced by control system parameters. Numerical examples 
illustrating complex maneuvers are provided. 

I. INTRODUCTION 

A quadrotor unmanned aerial vehicle (UAV) consists of 
two pairs of counter-rotating rotors and propellers. It has 
been envisaged for various applications such as surveillance 
or mobile sensor networks as well as for educational pur- 
poses, and several control systems have been studied. 

Linear control systems have been widely used to enhance 
the stability properties of an equilibrium of a quadrotor 
UAV [1], [2], [3]. In [4], the quadrotor dynamics is modeled 
as a collection of simplified hybrid dynamic modes, and 
reachability sets are analyzed to guarantees the safety and 
performance for larger area of operating conditions. 

Several nonlinear controllers have been developed as well. 
Backstepping and sliding mode techniques are applied in [5], 
[6], and a nonlinear Hqo controller is studied in [7]. An 
adaptive neural network based control system is developed 
in [8]. Since all of these controllers are based on Euler 
angles, they exhibit singularities when representing complex 
rotational maneuvers of a quadrotor UAV, thereby signif- 
icantly restricting their ability to achieve complex flight 
maneuvers. 

An attitude control system based on quaternions is applied 
to a quadrotor UAV [9]. Quaternions do not have singulari- 
ties, but they have ambiguities in representing an attitude, 
as the three-sphere S 3 double-covers SO (3). As a result, 
in a quaternion-based attitude control system, convergence 
to a single attitude implies convergence to either of the 
two disconnected, antipodal points on S 3 [10]. Therefore, 
depending on the particular choice of control inputs, a 
quaternion-based control system may become discontinuous 

Taeyoung Lee, Mechanical and Aerospace Engineering, The George 
Washington University, Washington DC 20052 tylee@gwu.edu 

Melvin Leok, Mathematics, University of California at San Diego, La 
Jolla, CA 92093 mleok@math.ucsd.edu 

N. Harris McClamroch, Aerospace Engineering, University of Michigan, 
Ann Arbor, MI 48109 nhm@umich.edu 

*This research has been supported in part by NSF under grants CMMI- 
1029551. 

tThis research has been supported in part by NSF under grants DMS- 
0726263, DMS-1001521, DMS-1010687, and CMMI-1029445. 



when applied to actual attitude dynamics [11], and it may 
also exhibit unwinding behavior, where the controller rotates 
a rigid body through unnecessarily large angles [12], [13]. 

Attitude control systems also have been developed directly 
on the special orthogonal group, SO (3) to avoid the sin- 
gularities associated with Euler-angles and the ambiguity 
of quaternions [14], [15], [16], [17]. By following this 
geometric approach, the dynamics of a quadrotor UAV is 
globally expressed on the special Euclidean group, SE(3), 
and nonlinear control systems are developed to track outputs 
of several flight modes, namely an attitude controlled flight 
mode, a position controlled flight mode, and a velocity 
controlled flight mode [18]. Several aggressive maneuvers 
of a quadrotor UAV are also demonstrated based on a 
hybrid control architecture. This is particularly desirable 
since complicated reachability set analysis is not required to 
guarantee a safe switching between different flight modes, 
as the region of attraction for each flight mode covers the 
configuration space almost globally. 

In this paper, we extend the results of [18] to con- 
struct nonlinear robust tracking control systems on SE(3) 
for a quadrotor UAV. We assume that there exist unstruc- 
tured, bounded uncertainties, with pre-determined bounds, 
on the translational dynamics and the rotation dynamics 
of a quadrotor UAV. Output tracking control systems are 
developed to follow an attitude command or a position 
command for the vehicle center of mass. We show that 
the tracking errors are uniformly ultimately bounded, and 
the size of the ultimate bound can be arbitrarily reduced. 
The robustness of the proposed tracking control systems are 
critical in generating complex maneuvers, as the impact of 
the several aerodynamic effects resulting from the variation 
in air speed is significant even at moderate velocities [2]. 

The paper is organized as follows. We develop a globally 
defined model for the translational and rotational dynamics of 
a quadrotor UAV in Section [II] A hybrid control architecture 
is introduced and a robust attitude tracking control system 



is developed in Section III Section IV present results for a 



robust position tracking, followed by numerical examples in 
Section [V] 

II. QUADROTOR DYNAMICS MODEL 

Consider a quadrotor UAV model illustrated in Figure 
[TJ This is a system of four identical rotors and propellers 
located at the vertices of a square, which generate a thrust 
and torque normal to the plane of this square. We choose 
an inertial reference frame {ei,e2,e3} and a body-fixed 
frame {&i,&2,&3}- The origin of the body-fixed frame is 
located at the center of mass of this vehicle. The first and 
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Fig. 1. Quadrotor model 

the second axes of the body-fixed frame, bi,b 2 , lis m the 
plane defined by the centers of the four rotors, as illustrated 
in Figure [l] The third body-fixed axis 63 is normal to this 
plane. Each of the inertial reference frame and the body- 
fixed reference frame consist of a triad of orthogonal vectors 
defined according to the right hand rule. Define 

m G K the total mass 

J G R 3x3 the inertia matrix with respect to the 

body-fixed frame 
R G SO (3) the rotation matrix from the body -fixed 

frame to the inertial frame 
SJeR 3 the angular velocity in the body-fixed 

frame 

i£R 3 the position vector of the center of mass 

in the inertial frame 
Del 3 the velocity vector of the center of mass 

in the inertial frame 
d GM. the distance from the center of mass to 

the center of each rotor in the b\ , b 2 

plane 

fi G M the thrust generated by the i-th pro- 

peller along the —63 axis 

Ti G K the torque generated by the i-th pro- 

peller about the 63 axis 

/eR the total thrust magnitude, i.e., / = 

Si=l fi 

M G M 3 the total moment vector in the body- 
fixed frame 

The configuration of this quadrotor UAV is defined by the 
location of the center of mass and the attitude with respect to 
the inertial frame. Therefore, the configuration manifold is 
the special Euclidean group SE(3), which is the semidirect 
product of M 3 and the special orthogonal group S0(3) = 
{R G M 3x3 I R T R = I, dct R = 1}. 

The following conventions are assumed for the rotors and 
propellers, and the thrust and moment that they exert on the 
quadrotor UAV. We assume that the thrust of each propeller 
is directly controlled, and the direction of the thrust of each 
propeller is normal to the quadrotor plane. The first and 
third propellers are assumed to generate a thrust along the 
direction of —63 when rotating clockwise; the second and 
fourth propellers are assumed to generate a thrust along 



the same direction of —63 when rotating counterclockwise. 
Thus, the thrust magnitude is / — Ylt=i fi' an< ^ ^ i s 
positive when the total thrust vector acts along —63, and 
it is negative when the total thrust vector acts along 63. By 
the definition of the rotation matrix R G S0(3), the total 
thrust vector is given by —fRe 3 G R 3 in the inertial frame. 
We also assume that the torque generated by each propeller 
is directly proportional to its thrust. Since it is assumed that 
the first and the third propellers rotate clockwise and the 
second and the fourth propellers rotate counterclockwise to 
generate a positive thrust along the direction of —63, the 
torque generated by the i-th propeller about 63 can be written 
as ^ — (—l) l c T ffi for a fixed constant c T j. All of these 
assumptions are common [3], [9]. 

Under these assumptions, the moment vector in the body- 
fixed frame is given by 
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The determinant of the above 4x4 matrix is 8c T fd 2 , so it 
is invertible when d 7^ and c T f 7^ 0. Therefore, for given 
thrust magnitude / and given moment vector M, the thrust of 
each propeller fx, f 2 , fs, fi can be obtained from ([TJ. Using 
this equation, the thrust magnitude / G K and the moment 
vector M G M 3 are viewed as control inputs in this paper. 

The equations of motion of the quadrotor UAV can be 
written as 

x = v, (2) 
mv = mge 3 - fRe 3 + A x , (3) 
R = RQ, (4) 

,m + n x ,m = m + a r , (5) 

where the hat map : M 3 — >• so (3) is defined by the condition 
that xy = x x y for all x, y G M 3 (see Appendix [a]). The 
inverse of the hat map is denoted by the vee map, V : 
50 (3) — > M 3 . Unstructured uncertainties in the translational 
dynamics and the rotational dynamics of a quadrotor UAV 
are denoted by and G K 3 , respectively. We assume 
that uncertainties are bounded: 

||A x ||<k, ||A h ||<$r (6) 

for known, positive constants 5 X , <5r € K. 

Throughout this paper, A m (-) and Am( - ) denote the min- 
imum eignevalue and the maximum eigenvalue of a matrix, 
respectively. 

III. ATTITUDE CONTROLLED FLIGHT MODE 

A. Flight Modes 

Since the quadrotor UAV has four inputs, it is possible to 
achieve asymptotic output tracking for at most four quadrotor 
UAV outputs. The quadrotor UAV has three translational 
and three rotational degrees of freedom; it is not possible 
to achieve asymptotic output tracking of both attitude and 
position of the quadrotor UAV. This motivates us to introduce 



several flight modes, namely (1) an attitude controlled flight 
mode, and (2) a position controlled flight mode. 

A complex flight maneuver can be defined by specifying 
a concatenation of flight modes together with conditions 
for switching between them; for each flight mode one also 
specifies the desired or commanded outputs as functions of 
time. Unlike a hybrid flight control system that requires 
reachability analyses [4], the proposed control system is 
robust to switching conditions since each flight mode has 
almost global stability properties, and it is straightforward to 
design a complex maneuver of a quadrotor UAV. 

In this section, an attitude controlled flight mode is consid- 
ered, where the outputs are the attitude of the quadrotor UAV 
and the controller for this flight mode achieves asymptotic 
attitude tracking. 

B. Attitude Tracking Errors 

Suppose that an arbitrary smooth attitude command 
Rd{t) € SO (3) is given. The corresponding angular velocity 
command is obtained by the attitude kinematics equation, 

We first define errors associated with the attitude dynamics 
of the quadrotor UAV. The attitude error function studied 
in [14], [19], [20], and several properties are summarized as 
follows. 

Proposition 1: For a given tracking command (Rd, f2<j), 
and the current attitude and angular velocity (R, 57), we 
define an attitude error function W : SO (3) x SO (3) — > R, an 
attitude error vector e R € M 3 , and an angular velocity error 
vector en € R 3 as follows: 

V(R,R d ) = ~ti[l-RjR], (7) 

e R = l -{R T d R-R T R d y i (8) 
e Q = Q - R T R d tt d , (9) 

Then, the following statements hold: 

(i) VP is locally positive-definite about R = Rd- 

(ii) the left-trivialized derivative of ^ is given by 

T* I L R (D R V(R,R d )) = e R . (10) 

(iii) the critical points of VP, where e R — 0, are {Rd} U 
{Rd exp(7rs), s e S 2 }. 

(iv) a lower bound of ^ is given as follows: 



1 



e R (R,R d )f < *(R,Rd), 



(11) 



(v) Let ip be a positive constant that is strictly less than 2. 
If ty(R,Rd) < ip < 2, then an upper bound of * is 
given by 



1 



Proof: See [20]. 



2-tp 



\e R (R, R d )\\ 



(12) 



C. Attitude Tracking Controller 

We now introduce a nonlinear controller for the attitude 
controlled flight mode, described by an expression for the 



moment vector: 



M 



-k R e R - knen + Q x Jfl 
- J(ClR T R d n d - R T R d Q d ) 

S R \\e A \\ + e R 



Mi?., 



£A = en 



c 2 J 1 e R , 



(13) 
(14) 
(15) 



where k R ,ku,C2,e R are positive constants. 

In this attitude controlled mode, it is possible to ignore 
the translational motion of the quadrotor UAV; consequently 
the reduced model for the attitude dynamics are given by 
equations |4]), Q, using the controller expression (13i-(15i. 
We now state the result that the tracking errors (e R , en) are 
uniformly ultimately bounded. 

Proposition 2: (Robustness of Attitude Controlled Flight 
Mode) Suppose that the initial attitude error satisfies 



*(R(0),R d (0)) < ?/>2 <2 



(16) 



for a constant ifa. Consider the control moment M defined in 
( 13 i-([T5]l. For positive constants k R , fco, the constants c 2 , e R 
are chosen such that 



c 2 < min <^ fcn 



^k n k R X m {J) 2 



k 2 n \ M {J) + ^k R \ m {J) 
A m (M 21 )A m (W 2 ) 



\AijA m (J) 



^2(2-^2), 



A M (M 22 ) 

where the matrices M21, M22, W2 € M 2x2 are given by 



(17) 
(18) 



M 21 = 



1 



k R 
-c 2 

W 2 



A, 



C2 

C2k n 
Am (J) 
_ c 2 kn 
2A m (J) 



Moo = 



1 



2-V-2 
C 2 



C 2 

Am (J). 



2A„ 

kn 



(J) 

C2 



Then, the attitude tracking errors (e R) en) are uniformly 
ultimately bounded, and the ultimate bound is given by 



|efl|| 



(19) 



Am(M 22 ) 

_ A 2 ,(M 2 i)A m (W 2 ) eil 
Proof: See Appendix |B| ■ 

From ( |16) , the initial attitude error should be less than 

180°, in terms of the rotation angle about the eigenaxis 

between R and Rd- We can further show that the attitude 

tracking errors exponentially converges to (19 1, where the 



size of the ultimate bound can be reduced by the controller 
parameter e R . It is also possible to achieve exponential 
attractiveness if the constant e R in ( p"4| ) is replaced by 
e R exp(— fit) for f3 > 0. All of these results can be applied to 
a nonlinear robust control problem for the attitude dynamics 
of any rigid body. 

Asymptotic tracking of the quadrotor attitude does not 
require specification of the thrust magnitude. As an auxil- 
iary problem, the thrust magnitude can be chosen in many 



different ways to achieve an additional translational motion 
objective. For example, it can be used to asymptotically track 
a quadrotor altitude command [18]. 

Since the translational motion of the quadrotor UAV can 
only be partially controlled; this flight mode is most suitable 
for short time periods where an attitude maneuver is to be 
completed. 

IV. POSITION CONTROLLED FLIGHT MODE 

We now introduce a nonlinear controller for the position 
controlled flight mode. This flight mode requires analysis of 
the coupled translational and rotational equations of motion; 
hence, we make use of the notation and analysis in the prior 
section to describe the properties of the closed loop system 
in this flight mode. 

A. Position Tracking Errors 

An arbitrary smooth position tracking command Xd(t) G 
M 3 is chosen. The position tracking errors for the position 
and the velocity are given by: 



x 
v ■ 



- x d , 
id- 



(20) 
(21) 



Following the prior definition of the attitude error and the 
angular velocity error, we define 

1 



e R — n(R c R — R Rc) 



en 



£1 — R Rr^lr 



(22) 



and the computed attitude R c (t) G SO(3) and computed 
angular velocity Vl c G M 3 are given by 

i?T R c . 



(23) 



(24) 



R c = [bi c ; b 3c x 6 lc ; b 3c ], n c 

where b 3c G S 2 is defined by 

_ -k x e x - k v e v - mge 3 + mx d + fi x 
\\-k x e x - k v e v - mge 3 + mx d + fJ. x [ 

and bi c G S 2 is selected to be orthogonal to b 3c , thereby 
guaranteeing that R c G SO(3). The constants k x ,k v are 
positive, and the control input term fj, x is defined later in 
d29l. We assume that 



k x e x k v 6y - mge 3 + mx d + Hx\\ 0, 



(25) 



and the commanded acceleration is uniformly bounded such 
that 

|| — mge 3 + mxd\\ < B (26) 
for a given positive constant B. 

B. Position Tracking Controller 

The nonlinear controller for the position controlled flight 
mode, described by control expressions for the thrust mag- 
nitude and the moment vector, are: 



/ = {k x e x + k v e v + mge 3 - mx d 
M = -k R e R - k n eo_ + D, x Jtt 

— J (TlR? R C Q C — R? R c tl c + i^r) 



li x )-Re 3 , (27) 
(28) 
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Fig. 2. Controller structure for position controlled flight mode 



eA 



§ r+2 



6l +1 \\e B \\ T+1 



$r\Wa\\ + e R.'' 
en + c 2 J~ 1 e R , 



,T+1 ; 



(29) 

(30) 

(31) 
(32) 



where fc x , k v , kR, fen, Ci, C2, e x , cr, t are positive constants, 
and r > 2. 



The nonlinear controller given by equations ( |27] i, ( 28 1 
can be given a backstepping interpretation. The computed 



attitude R c given in equation ( 23 i is selected so that the 



thrust axis —63 of the quadrotor UAV tracks the computed 



direction given by —b 3c in (24i, which is a direction of the 
thrust vector that achieves position tracking. The moment 
expression ( f28] > causes the attitude of the quadrotor UAV to 
asymptotically track R c and the thrust magnitude expression 



(27 1 achieves asymptotic position tracking. 

The closed loop system for this position controlled flight 
mode is illustrated in Figure [2] The corresponding closed 
loop control system is described by equations |2]i-(j5]l, us- 
ing the controller expressions ((27]>-((32]>. We now state the 
result that the tracking errors (e x , e v , eR, en) are uniformly 
ultimately bounded. 

Proposition 3: (Robustness of Position Controlled Flight 
Mode) Suppose that the initial conditions satisfy 



*(J2(O),i2 c (O))<'0 1 < 1, 
II e x (0)|| < e Xmaji , 



(33) 
(34) 



for positive constants ipi , e Xinax . Consider the control inputs 



f,M defined in (|27|-([32[i. For positive constants k x ,k v , we 

lat 

\fk~x~m 



choose positive constants c\, C2, kR, ku, e x ,€R such that 

4mk x k v (l — a) 2 



c\ < min < k v (l — a), 



fc 2 (l + a) 2 + 4mk x (l - a) ' 



c 2 < min <J kn, , 2 



(35) 

/, 4fcpfc fi A m (J) 2 / , , fn \ 

I k^x M {J) + 4k R \ m {jy j 

Xm(W 2 ) > 



\w 12 \\ 2 



4A m (W 1 )' 
e x + e R < 

min{A m (Mii), A m (M 2 i)}min{eg max , V>i(2 - ^1)} 
max{A M (M 12 ),A M (M^)} 



(36) 
(37) 

X m {W), 
(38) 



where a = y/i^\{2 — ipi), and the matrices M u , M 12 , M 2 i, 
M 22 ,W u Wi2,W 2 , W e M 2x2 are given by 



Mu = 



Mai = 



1 fc x — Ci 

2 — Cl TO 

fc_R -C 2 

-02 A m (J) 



Mia = 



M 22 = 



1 




2 


Cl 


r 2/cr 


2- 




L C 2 



Cl 



C2 



Wi = 

w 12 = 
w 2 = 
w = 



(1-a) 



2m ( 1 + «) 

^(1 + a) fc„(l-a)-ci 



2m 



£> + <5 T + fc I e Imai 

cik R _ c 2 kn 
A M (J) 2A m (J) 

~2A m (J) fc O-C 2 

A ro (Wi) -HlWialla" 
-IHW12II2 A m (W 2 ) 



Then, the tracking errors (e x , e v ,e R ,ea) are uniformly ulti- 
mately bounded, and the ultimate bound is given by 



{■ 



' + ||e„|r + He^ir + II e n H < 

max{A M (Mi 2 ),A M (M 22 )} 
min{ A m (Mu), A m (M 2 i)}A m ( W) 



>}■ 



(39) 

Proof: See Appendix |C| ■ 
This proposition shows that the proposed control system 
is robust to bounded, and unstructured uncertainties in the 
dynamics of a quadrotor UAV. Similar to Proposition [2] 
the ultimate bound can be arbitrarily reduced by choosing 
smaller e x , e R , and it is possible to obtain exponential 
attractiveness. 

Proposition [3] requires that the initial attitude error is less 
than 90° in ( |33] l. Suppose that this is not satisfied, i.e. 
1 < *(i?(0),i? c (0)) < 2. We can still apply Proposition |] 
which states that the attitude error exponentially decreases 
until it enters the ultimate bound given by ( p"9| ). If the 
constant e R is sufficiently small, we can guarantee that the 



attitude error function decreases to satisfy (33i in a finite 
time. Therefore, by combining the results of Proposition [2] 
and [3] we can show ultimate boundedness of the tracking 
errors when *(ii(0), -R c (0)) < 2. 

Proposition 4: (Robustness of Position Controlled Flight 
Mode with a Larger Initial Attitude Error) Suppose that the 
initial conditions satisfy 

l<*(i?(0),.R c (0))<V>2<2, (40) 
Ilex (0)|| < e Xmax , (41) 

for a constant ip2,^x majc - Consider the control inputs 
/, M defined in (27i-(32i, where the control parameters 
k x , k v , k R , ku, ci, c 2 , e x , e R satisfy p5]l-p8]> for a positive 



constant ipi < 1. If the constant e R is sufficiently small such 
that 



. X m (M 21 )X m (W 2 ) 

eR < x 7Tl—\ Vi(2 ~ ipi), 

Am (M22) 



(42) 



Plane 
normal to - 




: b 2c X b 3c 



Fig. 3. Convergence property of the first body-fixed axis: in the proposed 
control system, 63^ is determined by {24) . We choose a desired direction of 
the first body fixed axis, namely b\. that is not parallel to f>3 c , and project 
it on to the plane normal to b% c to obtain &i c . This guarantees that the 
first body-fixed axis converges to b\ a , and therefore it asymptotically lies 
in the plane spanned by bi d and b^^. As b-j c converges to the direction 
of ge r i — Xd in (24) , this allows us to specify the direction of the first 
body-fixed axis in the plane normal to ge$ — x^. For all cases, the ultimate 
convergence error is described by (39) . 

then the tracking errors (e x , e v , en, en) are uniformly ulti- 
mately bounded. 

Proof: See Appendix [P] ■ 

C. Direction of the First Body-Fixed Axis 

As described above, the construction of the orthogonal 
matrix R c involves having its third column &3 c specified by 
a normalized feedback function, and its first column b\ a is 
chosen to be orthogonal to the third column. The unit vector 
bi c can be arbitrarily chosen in the plane normal to b^, a , 
which corresponds to a one-dimensional degree of choice. 
This reflects the fact that the quadrotor UAV has four control 
inputs that are used to track a three-dimensional position 
command. 

By choosing £> lc properly, we constrain the asymptotic 
direction of the first body-fixed axis. Here, we propose to 
specify the projection of the first body-fixed axis onto the 
plane normal to b^ c . In particular, we choose a desired 
direction b\ d £ S 2 , that is not parallel to &3 c , and bi c 
is selected as bi c = Proj[6iJ, where Proj[-] denotes the 
normalized projection onto the plane perpendicular to b 3c . 
In this case, the first body-fixed axis does not converge to 
b\ d , but it converges to the projection of b\ d , i.e. b\ — > bi c = 
Proj[&iJ as t — > 00, up to the ultimate bound described by 
p9"l >. In other words, the first body-fixed axis converges to a 
small neighborhood of the intersection of the plane normal 
to &3 c and the plane spanned by b^ c and b\ d . This can be 
used to specify the heading direction of a quadrotor UAV in 
the horizontal plane (see Figure [3] and [18] for details). 

V. NUMERICAL EXAMPLES 

Numerical results are presented to demonstrate the prior 
approach for performing complex flight maneuvers. The 
parameters are chosen to match a quadrotor UAV described 
in [21]. 

J = [0.0820, 0.0845, 0.1377] kg -m 2 , m = 4.34kg 
d= 0.315 m, erf = 8.004 x 10~ 3 m. 

The controller parameters are chosen as follows: 

k x = 59.02, kv = 24.30, k R = 8.81, k u = 1-54 
ci = 3.6, c 2 = 0.6, e x = e R = 0.04. 
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Fig. 4. Case I: robust position controlled flight mode to follow an elliptic 
helix 
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Fig. 5. Case I: position controlled flight mode to follow an elliptic helix. 
The robust control input terms are set to zero, i.e. fi x = fj,n = 0, for 
comparison with Figure [4] 



We consider a fixed disturbance for the translational dynam- 
ics, and an oscillatory disturbance for the rotational dynamics 
as follows: 

= [2.50, 1.25, 2.00] T N, 
2 

A R (t) = ^[sin(87rt), sin(Trf), cos(47ri)] T Nm. 
v3 

The corresponding bounds of the disturbances are given by 
5 X = 4.34 and 5r = 2. We consider the following two cases. 
Case I (elliptic helix): The initial conditions are given 

by 

x(0) = [0.1, 0, 0] T m, v(0) = [0, 0, 0] T m/s, 
R(0) = /, fi(0) = [0, 0, 0] T rad/s. 

The desired position command is an elliptic helix, given by 



x d {t) = [0.4i, 0.4sin(7ri), -0.6cos(7rf)f J 



m. 



and the desired heading direction is fixed as b\ d — [1, 0, 0] T . 
This corresponds to the position controlled flight mode 
described in Proposition [3] as the initial attitude error is 
*(0) = 0.14 < 1. 

Figure [4] shows simulation results, where the position 
tracking error converges to a small neighborhood of the zero 
tracking errors, and the terminal tracking error is 1.2 cm. For 
comparison, we set the robust control input terms to zero, 
i.e. fi x = fiR = 0, and we repeat numerical simulations 
to obtain Figure [5] It is observed that the angular velocity 
tracking error is mostly driven by the disturbance A#, and 
the corresponding position tracking error is larger than 0.1 m. 
This illustrates the robustness of the proposed control system 
for a complex maneuver with larger disturbances. 



Case II (hovering): The initial conditions are given by 

x(0) = [0.1, 0, 0] T m, v(0) = [0, 0, 0] T m/s, 
R(0) = exp(0.997rei), ft(0) = [0, 0, 0] T rad/s, 

where ei — [1, 0, 0] € M 3 . The desired position command is 
given by 

x d {t) = [0,0,0] T m, 

and the desired heading direction is fixed as b\ d = [1, 0, 0] T . 
This describes a case that a quadrotor UAV should recover 
from an initially upside-down configuration. 

The initial attitude error is given by 1 < (^(0) = 
1.9995) < 2, and therefore, it corresponds to Proposition 
[4] that is based on both of the attitude controlled flight mode 
and the position controlled flight mode. 

Figure [6] illustrates excellent convergence properties of 
the proposed control system for a large initial attitude error, 
where the terminal position tracking error is 1.2 cm. Figure 
Figure [7] shows relatively poor tracking performances with a 
slower convergence when there are no robust control input 
terms proposed in this paper. 

Appendix 
A. Properties of the Hat Map 
The hat map • : M 3 — > so (3) is defined as 



-X 2 



X 



-x 3 




Xl 



•i'2 

-Xl 





(43) 



for x = [xi; £2; £3] G 1R 3 . This identifies the Lie algebra 
so (3) with M. 3 using the vector cross product in M 3 . The 
inverse of the hat map is referred to as the vee map, 
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Fig. 6. Case II: robust position controlled flight mode to recover from an 
initially upside-down configuration 



Fig. 7. Case II: robust position controlled flight mode to recover from an 
initially upside-down configuration. The robust control input terms are set 
to zero, i.e. /i x = fin = 0, for comparison with Figure [6] 



V : so (3) — > R 3 . Several properties of the hat map are 
summarized as follows. 



xy = x x y = —y x x = 
1 



-yx, 



(44) 
(45) 



tr[M] = tr[Af] = -tr[x(A - A T )} = -x T (A - A T ) y , 



(46) 
(47) 
(48) 



xA + A T x = ({ir[A]h^-A}x) A 1 
RxR T = {Rx) A , 

for any x,y € M 3 , A E R 3x3 , and R € SO(3). 

B. Proof of Proposition [2] 

We first find the error dynamics for en, en, and define 
a Lyapunov function. Then, we find conditions on control 
parameters to guarantee the boundedness of tracking errors. 

a) Attitude Error Dynamics: The attitude error dy- 
namics for ^ : en,ea are developed in [20], and they are 
summarized as follows: 

j t ^>{R,R d )) = e R -e n , (49) 

e R = E{R,R d )e n , (50) 
e n = ./^(-Q x Jfl + u + A R ) + ClR T R d n d - R T R d tl d , 

(51) 

where the matrix E(R,R d ) € M 3x3 is given by 

E(R, R d ) = l -(tv[R T R d ]I - R T R d ). (52) 
We can show that \\E(R,R d )\\ < 1 to obtain 

\\e R \\ < \\en\\. (53) 



Substituting the control moment ( 13 i into pi) , 

Je n = -k R e R - k n e n + A R , + fi R . (54) 
In short, the attitude error dynamics are given by equations 



( |49) , q50| >, pty , and they satisfy ( |53j >. 

b) Lyapunov Candidate: Let a Lyapunov candidate V 2 

be 

1 



V 2 = ^en • Jen + k R R d ) + c 2 e R ■ en- 



(55) 



We analyzes the properties of V 2 along the solutions of the 
controlled system in the following domain D 2 : 

D 2 = {(R, SI) e S0(3) x R 3 | V{R, R d ) < (56) 

From ( (TT) , (12) , the attitude error function is bounded in 
Z? 2 as follows: 



M| 2 < *{R,Rd) < 



2-^2 



(57) 



which implies that $ is positive-definite and decrescent. It 
follows that the Lyapunov function V 2 is bounded as 



z 2 M 21 z 2 <V 2 < z 2 M 22 z 2 



where z 2 = [\\e R \\, 
Mi 2l M 22 are given by 



(58) 

2 , and the matrices 



M 2 i = 



1 



-C2 

-c 2 A m (J) 



M 22 = 



2k R 
2-V-2 
C 2 



c 2 
Am (J). 



(59) 



From equations ( |49] l, ( p0| ), ( |54] >, the time derivative of V 2 
along the solution of the controlled system is given by 



V 2 



-Atoll en I 



c 2 k R e R -J 1 e R + c 2 E(R,R d )en ■ en 



c 2 k n e R -J 1 e n + (e n + c 2 J l e R ) ■ (A R + fi R ). 

(60) 



Since \\E(R d , R)\\ < 1, this is bounded by 

V 2 < -gWiZi + e A ■ (A R + n R ), 

where e A = en + c 2 J~ 1 e R £ M 3 and the matrix W 2 S 
is given by 



(61) 



W 2 



Xm(J) 

_ c 2 kg 
~2A m (J) 



C2kg 
2A m (J) 

kn - c 2 



(62) 



Substituting ( 14 1, the last term of (61 1 is bounded by 

^IIMI 2 



e A ■ (A R + fi R ) = S R \\e A \\ - 
= £R 

to obtain 



^He^H + e R 
5r\\&a\ 



Sr\Wa\\ + £r 



V 2 < -z 2 W 2 z 2 + e R , 



(63) 



c) Boundedness: The condition ( fT7] i for the constant 
c 2 guarantees that the matrix W 2 in ( |63] l and the matrices 
M 2 i,M 22 in (|58]l are positive-definite. Therefore, we obtain 



(64) 
(65) 



A m (M 2 i)||z 2 || 2 < V 2 < A M (M 22 )||z 2 || 2 , 
V 2 < -Kn(W 2 )\\z 2 \\ 2 + e R . 

This implies that V 2 < when 



v / A M (A/22) a , 
A m (W2j 



Consider a sub-level set of the Lyapunov function V 2 , 



defined as 5 7 = {(R,ty G SO(3) 



V 2 < 7} for a 



positive constant 7. If 7 satisfies the following inequality 

7< {A m (Af 21 )^ 2 (2-^ 2 )-d 2 }, 

then we can guarantee that SL is a subset of the domain D 2 
defined in ( |56) . 

In short, a sub-level set of the Lyapunov function, 5 7 is a 
positively invariant set when di < 7 < d 2 , and any solution 
starting in S~ exponentially converges to S^- To guarantee 
the existence of such a set, we require 



di 



A M (M 22 ) 

Xm{W 2 ) 



eR > < 



which can be achieved by ( p"8| ). Then, according to Theo- 
rem 5.1 in [22], the attitude tracking errors are uniformly 
ultimately bounded, and the corresponding ultimate bound 
is estimated by 



S dl C ||z 2 || 2 < 



Am(A/ 22 ) 



C. Proof of Proposition [3] 

We first derive the tracking error dynamics and a Lya- 
punov function for the translational dynamics of a quadrotor 
UAV, and later it is combined with the stability analyses 
of the rotational dynamics in Appendix [B] to guarantee the 
boundedness of tracking errors. 

The subsequent analyses are developed in the domain D\ 

D 1 = {(e x ,e v ,R, e n ) £l 3 xR 3 x SO(3) x K 3 | 

IMI < e Kmax , * < ipi}, (66) 
Similar to ( f57] >, we can show that 

1 'Ml 2 <*(R,Rc) < ' 



\ e R\ 



2 ,_„ --_-_ 2 _^„_ • (67) 

a) Translational Error Dynamics: The time derivative 
of the position error is e x — e v . The time-derivative of the 
velocity error is given by 

me v = mi — mid = mge 3 — fRe 3 — mxd + A x . (68) 

Consider the quantity ejR^Re 3 , which represents the cosine 
of the angle between 63 = Re 3 and b C3 — R c e 3 . Since 
1 — \l/(-R, R c ) represents the cosine of the eigen-axis rotation 
angle between R c and R, we have 1 > e 3 R^Re 3 > 1 — 
^(i?,i? c ) > in D\. Therefore, the quantity e T R \ Re ^ is 
well-defined. To rewrite the error dynamics of e v in terms 
of the attitude error e R , we add and subtract e T R T Re3 Rc^3 
to the right hand side of ( |68| ) to obtain 

/ 



me v = mge 3 — mxd 

where X £ R 3 is defined by 

/ 



R c e 3 -X + A x , (69) 



X 



^RTR 63 



{(eZRZRe 3 )Re 3 - R c e 3 ) 



(70) 



Let A — ~k x e x — k v e v — mge 3 -\-mxd + ^ x - Then, from \21\ , 
(|24ji, we have f = -A- Re 3 and 6 3c = R c e 3 = -A/ \\A\\, 
i.e., —A = \\A\\R c e 3 . By combining these, we obtain / = 
(\\A\\ R c e 3 ) ■ Re 3 . Therefore, the third term of the right hand 
side of 4691 can be written as 



/ 



elR T c Re. 



-R c e 3 = - 



\A\\R c e 3 ) -Re 3 



A 



= A 



eTR*Re 3 \\A\\ 
= -k x e x - k v e v - mge 3 + mx d + (jl x 



Substituting this into ( 69 1, the error dynamics of e v can be 
written as 



k x c x k v G v X -\- A x -\- 



(71) 



b) Lyapunov Candidate for Translation Dynamics: Let 
a Lyapunov candidate Vi be 

Vi = ^fcxllexll 2 + ^ m 1 1 1 1 2 + c x e x ■ e v . (72) 



A m (M 21 )A m (W 2 ) 



(R 



The derivative of Vi along the solution of ( |7T] i is given by 

i'i n mi 11 2 c i^x 11 n 2 c \k v 

Vi = -{k v - ci) e„ \\e x \\ e x ■ e v 

m m 

+ {X + A x + t i x } ■ {—e x + e v \ . (73) 



From (29 1, ( 30 », the last part of (73 1 is bounded by 

&l +2 \\e B \\ T+2 



e B ■ (A x + fi x ) < 5 x \\e B \\ - 



Sx\\e B \\e 



Sx ■ -\\e B \, 

r+l 

7+T — €x ' 



5l +1 \\e B \\^ , ... 
The last inequality is satisfied, since if ^ ||e^ || < £x 

f T + l 

$x\\e B \\ 



(74) 



c) Lyapunov Candidate for the Complete System:: Let 
V = Vi + V2 be the Lyapunov candidate of the complete 
system. 

V = ^Me^l 2 + 7, m IKH 2 + c i e x ■ e v 

+ ^eo • Jen + k R ^(R, R d ) + c 2 e R ■ e n . (78) 



Using ( 67 1, the bound of the Lyapunov candidate V can be 



Sl +1 \\e B \\ T+1 



-7+1 < 5x||es|| < £i 



written as 



and if 4||e s || > e 2 



<5J +1 I 



e B \ 



Sl +1 \\e B \\ 



T+l 



(s x \\e B \\y 



< 



S x \\e B \ 



(x < e. 



zlMuZi + z%M 21 z 2 <V< zlM 12 zi + zlM' 22 z 2 , (79) 

where zi = [\\e x \\, ||e.„||] T , z 2 = [\\e R \\, \\e n \\] T £ M. 2 , and 
the matrices M\\, M12, M 2 \, M 22 are given by 



Now we find a bound of X given by (70 1. Since / 

\\A\\{ejR^Re 3 ), we have 



Mi, = 



1 



||X|| < \\A\\ \\(elR^Re 3 )Re 3 -R c e 3 \\ 



M- 



21 



Ci 

k R -c 2 
-c 2 A m (J) 



"Cl 

rn 



M12 = 



M 22 = 



1 



ci m 



2fc a 
2—01 

C2 



C2 

Am (J) 



< (M e *ll + k v \\e v \\ +B + S X ) ||(e 3 i? c Re 3 )Re 3 - R c e 3 \\. Using ^ and (JTT), the time-derivative of V is given by 

V < -zlW lZl + z\W 12 z 2 - zlW 2 z 2 + e x + e R , (80) 
where W\,W\2,W2 £ R 2x2 are defined as follows: 

a^(l-a) 



The last term || (e 3 R^Re 3 )Re 3 — i? c e3| represents the sine 
of the angle between b 3 = Re 3 and b C3 = R c e 3 , since 

(b 3c • 63)63 - b 3c = b 3 x (63 x 63 J. 



The magnitude of the attitude error vector, ||efl|| represents 
the sine of the eigen-axis rotation angle between R c and R 
(see [18]). Therefore, we have \\(e 3 Rj Re 3 )Re 3 — R c e 3 \\ < 
\\e R \\. It follows that 

\\{eTR T d Re 3 )Re 3 - R d e 3 \\ < \\e R \\ = ^(2 - ¥) 

/ ^ 1 (2-Vi)-a} < 1. 

(75) 



W 12 

w 2 



-a^(l + a) 
+ a) k v (l-a) 



2m 



< 



2m 



Cl 



(5 



B + <5 X + 

C2kn 
Aa/(J) 

2A m (J) 



_ c 2 k n 
2\ m (.J) 

hi - C 2 



(81) 
(82) 

(83) 



Therefore, X is bounded by 

||*|| < (Me*ll + Me»l 

^ (fca;||Ca;|| + fcu||e„| 

Substituting ([74j», ((76) into {73] i, 

I — ci)||e w || 2 
-(1 + ajlleajjlllecll 



B + <k)||eji|| 
S + 5 x )a. 



(76) 



Vi < -(fc^i 

C\k v 



C\k x 



d) Boundedness: Under the given conditions ( 35 1, ( 36 1, 
all of the matrices M u , M 12 , M 21 , M 22 , Wi, and W 2 
are positive-definite. Therefore, the Lyapunov function V is 
positive-definite and decrescent to obtain 

min{A m (Af 1 i),A m (M 2 i)}||z|| 2 < V 

< max{A M (Af 12 ),A M (A/22)}l|2|| 2 , (84) 
T £ M 2 , and the time-derivative of 



(l-o)l|ex|| 5 



where z — y\z\\ 
V is bounded by 



Z2 



m 

+ \\e R \\ \{B + <y(— ||e x || + ||e„||) + k x \[ 



Kll} 
(77) 



In the above expression for V\, there is a third-order error 
term, namely fc !E ||e.R||||e a! ||||e u ||. Using (75i, it is possible 
to choose its upper bound as fc^aH || ||e„|| similar to other 
terms, but the corresponding stability analysis becomes com- 
plicated, and the initial attitude error should be reduced 
further. Instead, we restrict our analysis to the domain 
D\ defined in (661, and its upper bound is chosen as 
^ e x max ||ei?|j||e„||. 



V < -A m (Wi)||zi|| 2 + HWiallalNIIM - A ro (W 2 )IN 

+ fx + (R 

= ~z T Wz + e x + e R 
< -\ m {W)\\z\\ 2 + e x +e R . 

where the matrix W £ IR 2x2 is given by 



(85) 



W 



12 2 



-\ \\W X 2 || 2 
Xm(W 2 ) 



(86) 



Similar to the proof of Proposition [2j we can show that 
the tracking errors are uniformly ultimately bounded if the 
constants e x ,e R are sufficiently small, as given in (38 1, and 
the corresponding ultimate bound is given by ( 39 ». 



D. Proof of Proposition |4] 

The given assumptions satisfy the assumption of Propo- 
sition from which the tracking error z 2 — [||e#|| , ||en||] T 
is guaranteed to exponentially decrease until it satisfies the 



bound given by (19 1. But, (42 1 guarantees that the attitude 



error enters the region defined by (33 1 in a finite time t*. 

Therefore, if we show that the tracking error z\ = 
[|| e x||i || e «l|] T is bounded in t £ [0,t*] as well, then the com- 
plete tracking error (z%, z 2 ) is uniformly ultimately bounded. 

The boundedness of z\ is shown as follows. The error 
dynamics or e v can be written as 

me v = mge 3 - fRe 3 - mx d + A x . 

Let V3 be a positive-definite function of ||e x || and ||e„||: 

V 3 



l\\e x \\ 2 + lm\\e v \\ 2 ■ 



Then, we have ||e x || < y/2V 3 , 
derivative of V3 is given by 

V 3 = e x ■ e v -+ 

< ||eJ|||e„ 



< J A V 3 . The time- 



(mge 3 ■ 



fRe 3 - mxd + A x ) 
■S x ) + \\e v \\\\Re 3 \\\f\. 



From d27l, we obtain 



&v II &v I 



B + 5 X ) 



V 3 < \\e x \\\\e v \\ + \\e v \\{B + 5 x 
+ \\e v \\(k x \\e x \\ + k v \\e v \\ 

2 + (2(B + 5 X ) + (k x + l)\\e x \\)\\e v \ 
d 2 ^, 



<diV 3 



where d x = k v ± + 2(k x + 1)^=, d 2 = 2{B + 5 X ) 
Suppose that V 3 > 1 for a time interval [i a ,tb] C [0,t 
this time interval, we have y/Vs < V 3 . Therefore, 



2_ 
a ' 

In 



V 3 < (di + d 2 )V 3 



V 3 (t)<V 3 (t a )e^ +d ^ t ^. 



Therefore, for any time interval in which V 3 > 1, V 3 
is bounded. This implies that V 3 , and therefore z\ = 

[Il e x||, ||e«||] T , are bounded for < t < t* . 



[7] G. Raffo, M. Ortega, and F. Rubio, "An integral predictive/nonlinear 
Hoo control structure for a quadrotor helicopter," Automatica, vol. 46, 
pp. 29-30, 2010. 

[8] C. Nicol, C. Macnab, and A. Ramirez-Serrano, "Robust neural network 
control of a quadrotor helicopter," in Proceedings of the Canadian 
Conference on Electrical and Computer Engineering, 2008, pp. 1233— 
1237. 

[9] A. Tayebi and S. McGilvray, "Attitude stabilization of a VTOL 
quadrotor aircraft," IEEE Transactions on Control System Technology, 
vol. 14, no. 3, pp. 562-571, 2006. 

[10] C. Mayhew, R. Sanfelice, and A. Teel, "Quaternion-based hybrid 
control for robust global attitude tracking," IEEE Transactions on 
Automatic Control, 2011. 

[11] , "On the non-robustness of inconsistent quaternion-based attitude 

control systems using memoryless path-lifting schemes," in Proceed- 
ing of the American Control Conference, 2011. 

[12] S. Bhat and D. Bernstein, "A topological obstruction to continuous 
global stabilization of rotational motion and the unwinding phe- 
nomenon," Systems and Control Letters, vol. 39, no. 1, pp. 66-73, 
2000. 

[13] C. Mayhew, R. Sanfelice, and A. Teel, "On quaternion-based attitude 
control and the unwinding phenomenon," in Proceeding of the Amer- 
ican Control Conference, 2011. 

[14] F. Bullo and A. Lewis, Geometric control of mechanical systems, ser. 
Texts in Applied Mathematics. New York: Springer- Verlag, 2005, 
vol. 49, modeling, analysis, and design for simple mechanical control 
systems. 

[15] D. Maithripala, J. Berg, and W. Dayawansa, "Almost global tracking 
of simple mechanical systems on a general class of Lie groups," IEEE 
Transactions on Automatic Control, vol. 51, no. 1, pp. 216-225, 2006. 

[16] D. Cabecinhas, R. Cunha, and C. Silvestre, "Output-feedback control 
for almost global stabilization of fully-acuated rigid bodies," in Pro- 
ceedings of IEEE Conference on Decision and Control, 3583-3588, 
Ed., 2008. 

[17] N. Chaturvedi, A. Sanyal, and N. McClamroch, "Rigid-body attitude 
control," IEEE Control Systems Magazine, vol. 31, no. 3, pp. 30-51, 
2011. 

[18] T. Lee, M. Leok, and N. McClamroch, "Control of complex 
maneuvers for a quadrotor UAV using geometric methods on SE(3)," 
arXiv. [Online]. Available: http://arxiv.org/abs/1003.2005 

[19] N. Chaturvedi, N. H. McClamroch, and D. Bernstein, "Asymptotic 
smooth stabilization of the inverted 3-D pendulum," IEEE Transac- 
tions on Automatic Control, vol. 54, no. 6, pp. 1204-1215, 2009. 

[20] T. Lee, "Robust adaptive geometric tracking controls on SO(3) with 
an application to the attitude dynamics of a quadrotor UAV," arXiv, 
2011. [Online]. Available: http://arxiv.org/abs /1108l603T1 

[21] P. Pounds, R. Mahony, and P. Corke, "Modeling and control of a large 
quadrotor robot," Control Engineering Practice, vol. 18, pp. 691-699, 
2010. 

[22] H. Khalil, Nonlinear Systems, 2nd Edition, Ed. Prentice Hall, 1996. 



References 

[1] M. Valenti, B. Bethke, G. Fiore, and J. How, "Indoor multi-vehicle 
flight testbed for fault detection, indoor multi-vehicle flight testbed for 
fault detection, isolation, and recovery," in Proceedings of the AIAA 
Guidance, Navigation and Control Conference, 2006. 

[2] G. Hoffmann, H. Huang, S. Waslander, and C. Tomlin, "Quadrotor 
helicopter flight dynamics and control: Theory and experiment," in 
Proceedings of the AIAA Guidance, Navigation, and Control Confer- 
ence, 2007, AIAA 2007-6461. 

[3] P. Castillo, R. Lozano, and A. Dzul, "Stabilization of a mini rotorcraft 
with four rotors," IEEE Control System Magazine, pp. 45-55, 2005. 

[4] J. Gillula, G. Hoffmann, H. Huang, M. Vitus, and C. Tomlin, "Ap- 
plications of hybrid reachability analysis to robotic aerial vehicles," 
The International Journal of Robotics Research, vol. 30, no. 3, pp. 
335-354,2011. 

[5] S. Bouabdalla and R. Siegward, "Backstepping and sliding-mode 
techniques applied to an indoor micro quadrotor," in Proceedings of 
the IEEE International Conference on Robotics and Automation, 2005, 
pp. 2259-2264. 

[6] M. Efe, "Robust low altitude behavior control of a quadrotor rotor- 
craft through sliding modes," in Proceedings of the Mediterranean 
Conference on Control and Automation, 2007. 



